
#include "systick.h"
#include "Twi.h"
#include "Twi_Quene.h" 

#define I2C_RegAddrLen 0

#define Twi_ErrorHook(reason,id)


uint8 CRC8Table[]=
{						//120424-1			CRC Table
	0x00,0x07,0x0E,0x09,0x1C,0x1B,0x12,0x15,0x38,0x3F,0x36,0x31,0x24,0x23,0x2A,0x2D,
	0x70,0x77,0x7E,0x79,0x6C,0x6B,0x62,0x65,0x48,0x4F,0x46,0x41,0x54,0x53,0x5A,0x5D,
	0xE0,0xE7,0xEE,0xE9,0xFC,0xFB,0xF2,0xF5,0xD8,0xDF,0xD6,0xD1,0xC4,0xC3,0xCA,0xCD,
	0x90,0x97,0x9E,0x99,0x8C,0x8B,0x82,0x85,0xA8,0xAF,0xA6,0xA1,0xB4,0xB3,0xBA,0xBD,
	0xC7,0xC0,0xC9,0xCE,0xDB,0xDC,0xD5,0xD2,0xFF,0xF8,0xF1,0xF6,0xE3,0xE4,0xED,0xEA,
	0xB7,0xB0,0xB9,0xBE,0xAB,0xAC,0xA5,0xA2,0x8F,0x88,0x81,0x86,0x93,0x94,0x9D,0x9A,
	0x27,0x20,0x29,0x2E,0x3B,0x3C,0x35,0x32,0x1F,0x18,0x11,0x16,0x03,0x04,0x0D,0x0A,
	0x57,0x50,0x59,0x5E,0x4B,0x4C,0x45,0x42,0x6F,0x68,0x61,0x66,0x73,0x74,0x7D,0x7A,
	0x89,0x8E,0x87,0x80,0x95,0x92,0x9B,0x9C,0xB1,0xB6,0xBF,0xB8,0xAD,0xAA,0xA3,0xA4,
	0xF9,0xFE,0xF7,0xF0,0xE5,0xE2,0xEB,0xEC,0xC1,0xC6,0xCF,0xC8,0xDD,0xDA,0xD3,0xD4,
	0x69,0x6E,0x67,0x60,0x75,0x72,0x7B,0x7C,0x51,0x56,0x5F,0x58,0x4D,0x4A,0x43,0x44,
	0x19,0x1E,0x17,0x10,0x05,0x02,0x0B,0x0C,0x21,0x26,0x2F,0x28,0x3D,0x3A,0x33,0x34,
	0x4E,0x49,0x40,0x47,0x52,0x55,0x5C,0x5B,0x76,0x71,0x78,0x7F,0x6A,0x6D,0x64,0x63,
	0x3E,0x39,0x30,0x37,0x22,0x25,0x2C,0x2B,0x06,0x01,0x08,0x0F,0x1A,0x1D,0x14,0x13,
	0xAE,0xA9,0xA0,0xA7,0xB2,0xB5,0xBC,0xBB,0x96,0x91,0x98,0x9F,0x8A,0x8D,0x84,0x83,
	0xDE,0xD9,0xD0,0xD7,0xC2,0xC5,0xCC,0xCB,0xE6,0xE1,0xE8,0xEF,0xFA,0xFD,0xF4,0xF3
};

/**
  * @brief  calc crc8
  * @param  p:data pointer counter:number
* @retval 0:succes
  */
uint8 CRC8cal(uint8 *p, uint8 counter)    		   //look-up table calculte CRC 
{
    uint8 crc8 = 0;    
    
	for( ; counter > 0; counter--)
	{    
		crc8 = CRC8Table[crc8^*p];    
	    p++;
    }
    return(crc8);
}

/**
  * @brief  Twi_Write through I2C
  * @param  
  * @retval 0:succes
  */
Std_ReturnType Twi_Write(uint32 I2Cx,uint8 writeID, uint8 WrAddr, uint8 Length, uint8 *WrBuf,MTP_READ_TYPE type)
{
	uint8 i;
    uint8 TempBuf[4];
	Std_ReturnType result = E_NOT_OK;
    Twi_Data quene_data;

    TempBuf[0] = writeID;
    for ( i = 0; i < Length; i++)
    {
        TempBuf[1] = WrAddr+i;
        TempBuf[2] = *(WrBuf + i);
        TempBuf[3] = CRC8cal(TempBuf, 3);
        if (type == EEPROM)
        {
            quene_data.i2c = I2Cx;
            quene_data.id = writeID;
            quene_data.RegAddr = TempBuf[1];
            quene_data.data = TempBuf[2];
            quene_data.crc = TempBuf[3];
            if (E_NOT_OK == Twi_PushQueue(quene_data)) 
            {
                result = E_NOT_OK;
                Twi_ErrorHook(3,quene_data.id)
            }
            else
            {
                result = E_OK;
            } 
        }
        else
        {
            result = (uint8)I2C_Write_NBytes(I2Cx, writeID, TempBuf[1], 2,&TempBuf[2],I2C_RegAddrLen);
			if (Length > 1)
			{
				delay_1ms(2);
			}
        }
    }
	return result;
}

/**
  * @brief  TwiRead through I2C
  * @param  
  * @retval 0:succes
  */
Std_ReturnType TwiRead(uint32 I2Cx,uint8 readID, uint8 RdAddr, uint8 Length, uint8 *RdBuf)
{
	Std_ReturnType result = E_NOT_OK;
    result = I2C_Read_NBytes(I2Cx, readID, RdAddr, Length, RdBuf, I2C_RegAddrLen);
    #if 0
		uint8 RdCrc,i;
	  uint8 *TempBuf;
    if(RdCrc == CRC8cal(TempBuf, 4+Length))
    {
        //goto CopyData;
        for(i=0; i<Length; i++)
        {
            *RdBuf = TempBuf[4+i];
            RdBuf++;
        }
    }
    #endif
	return result;
}

/**
  * @brief  Twi_MainFunction
  * @param  
* @retval void
  */
void Twi_MainFunction(void)
{
    Twi_Data twiData;
    uint8 dataBuf[2];
    if (E_OK == Twi_PopQueue(&twiData))
    {
        dataBuf[0] = twiData.data;
        dataBuf[1] = twiData.crc;
        if (E_NOT_OK == I2C_Write_NBytes(twiData.i2c, twiData.id, twiData.RegAddr, 2,&dataBuf[0],I2C_RegAddrLen))
        {
            /* call error hook */
            Twi_ErrorHook(1,twiData.id);
        }
        else
        {

        }
    }
}
